MATLAB Code for k mean without using built in functions